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force-feedback a^ocattohs 
kefbrehge to kb1/atbd afphiaotons 

This invention claims pdadft of t£S* Provisional AppbV 
' cation Serial No, 60/005,861* fried Oat, 26, 1995, the entire 
contents, of "Which axe incorporated herein fay r&ibrence. 

1 FIELD OFT^lISfVHmXOK 

* * The present invention relates genially to fares feedback 
and, mbre particularly, ta the tsso of gyroscopic stabilization 
to provide an inertia! ixarne against which a force-relicctiiig 
cteVice- react, ' . 

* ■ . BACKOROXJKD OF THE IbTVENTIOH 

Fcrce-f«edback tedhnalpg# and related 'd&vlcfcjs paay bs ' 
divided into font broad application axaas: medical, 
entertainment, tsleopearations, and -virtual reality. 
TdLcaporatLons, *he research' of wMcb provided the founda- 
tion for dW deveLopmerU: of f orce-feedback devices, is the 
process af locally controlling a remote- device, The primary 
difference between virtual reality and teleoperations is in the 
objects which they control. With teleoperations, actnal 
physical robots are manipulated in tb& real world, whereas 
virtual reality involves simulated devices in synthetic 
Worlds. Farce-feedback foe telerobottes has evolved large 
and bulky mechamcalarms to more joystick-like designs. In 
. general/ these -devices arc designed for six degree-o£- 
freedom ( 6DOF) force feedback, and haw the capability to 
provide high levels of force. More recently, fLngcr~Q$erated 
dsvtc&s nerve- also been introduced for use in tela operations 
applications. 

The use of farce feedback in sucdical training, simulatiojx f 
and taleoperations is also increasing, with the primary 
application being iidnhxtally invasive surgical techniques 
which use laparscopic tools to perform, intricate tasks when 
in sea-ted into body cavities thxoigh small incisions. To 
realistically Emulate laparoscopic tool forces, special- 
purpose force-feedback: devices ar& currently under deval- 
opraent 

, The entertainment field is very dif&cult- to address with 
f cores-feedback technology, since Hie applications demand 
both, higher perforxnajice and lower costs* There are throe 
priniary jnarksts for force feedback devices m entertain- 
meat: location-based eatertainirient (LBB) T arcades, and 
home entertainment IJBH demands the highest performance 
while home entertahsmeiit deanands the lowest cost* Despite 
"the conflicting d^naands, progress' is being made in each of 
. these fields. 

3t may be argued that each of the appHcaiion domains just 
described has its roots 'in virtual reality, which is becoming 
dominant in all ixamsrsrye applications. As a consequence, ' 
on-going research in tamersive applications is often termed 
'Virtnal reality" whereas, when, the r&search is coxnpleted, 
the zrppHcatiott is given a specific name, such as a surgical 
simulator. Overall, virtual reality is becoming increasingly 
papular as a preferred means of interacting with, many 
scafcntr&c and engineering applications. To cite two of many 
' e^arnples, molecular modeling and automobile; design aro 
moving front standard graphics, carried out on conventional 
graphics tsmiroalsj to more interactive environments utiliz- 
• ing 3-D* stereo graphics, head-mounted displays and force 
feedback. 

As- visualization is a vesy hnportaxit -aspect dfthes& 
applications, interesting and useful technolo^es are being 
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' 'developed, including graphical object xepucs entatioos- and 
large working voMoaes (CAS/HS). Coucurrea&y, 'huptic 
interfaces arc being perfected, which enable manual inter- 
actions with victual eavsroaments or teleoperated remote 

5 systems. The haptic system is a umque sensory system in 
that it can. both sense the euvkonmmt and allow a user to 
react accordingly. "As -a' result, haptic &&vxcq$ not only 
stimulate the user with realistic sensor input (forces * tactile 

• sensations, heat, slip, etc,), hat also sense the user*s actons 

id so that realistic sensory inputs can be generated, Haptic 
devices are divided into two classes t depending upon the 
type of sensory iiiforrnatiart being simulated. The first, 
tactile, refers tb the sense of contact with the object The 
second, iinssthefiC;, refers to the sense of position and 

15 mottoa of a -user's limbs along with associated fosses* 

Broadly; these: approaches point toward the same goal: to 
immase a persoa in a sesirdhgiy visual reality, corcGplete 
■ with haptic feedback. However, a major def ciency with all 
ejdstiag- force-generating devices is' the .requirement that 

20 they be connected to a fixed frame, thus lorcixtg immobility 
6a the Tuser, State^f-ther-art force-feedback devices, for 
example, arc table mounted, requiring the device to be 
mounted to an iromobile object in order to geuerats a feed ■ 
point of leverage for forces and/or torqnes. Consequently,, no 

25 existing f arise feedback: device allows for easy mobility and 
force geararatioa, This problem 'is fundamental., since many 
virtual reality applications require large woddrig volumes 
and the ability to move £:eely within these volumes* to 
provide realistic visual and audio feedback doxiBg walk- 
so tbrongh scenarios, for example. 

In summary, _ large, immersive environments such as 
CAVES curreatiy ladk haptic feedback primarily because 
the casting technology will not support unrestricted motion. 
TMs leads to one cojsdkosiojL that force-feedback devices 

3S must migrate as visual technologies have, that is. from the 
desktop to large-volume, immersive environments. 
However, the design of a hand-held, spatially unrestricted 
f corc&rfeedbaak device is faadameatally different from exist- 
ing devices, which typically use primarily electrocmechanical 

40 or pneumatic actuators operating against toed supports to 
achieve active force feedback. Hear i& the realisation of such 
a device intuitively obvious, lb construct an &-axis joystick, 
requiring 1, 2, 3- to n-fr-3 motors* presents sigrdS-caiit 
challenges, for example, since the additional motors may 

4$ . signiiicaiitly increase the cost and/or weight of the device. 

SUMMARY OF THE IRVENTEOK 
The present invention addressee- the need for force feed- 
back in large, torneasive environments by providing a 

50 device that uses a ^yro^stabiiisation to generate a fixed point 
of leverage for the requisite forces and/or torques. In, one 
embodiment* one ox snore . orthogonally oriented rotating 
gyroscopes are used to provide a stable body or platform to 
Which a force-reflecting device can be mounted, thereby 

55 coupling reaction forces to the user withoat the need for 
conaaction to a toed frame. In one embodiment, a nser- 
ixuS^cactabl* member is physically coupled to a stabilized 
body, with* the control structure used for stahflf nation aad 
that used to mitigate force-feedback being substantially 

60 ih&epeh&eat of one another, enabling diff erect stab&i&ation 
mechanisms as described herein to be used with ssdstbig 
force-feedback capabilities. In alternative embodiments, 
inventive apparatus and^ioetbods are used which, take into 
account both the movements associated with the gyroscopic 

65 stabilization, a user's movements, and the application of 
torques and forces to realize a spatially imrestricted force- 
feedback device requiring fewer motors and structural c&s- 
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meats. Spacificaliy, an inventive control scheme is used in i 
thes6 cases to accelexrate and decelerate the uaotox(s.) asso- * 
elated, v/iih providing the; gyroscopic stabilizatioii such that 
only the desired tactile feedback is experienced by the user. 
All of the "various approaches are applicable to single and. 
jcxnilttplfe -degrees of freedom 

A three-axis iicplexa&ntatioii includes a. set of three, 
mutually perpendicular momentum wheals whicu form the 
gyro-stabilized platform, an attitude measuring device^, and 
a control system The attitude measuring device is employed 
to detect -disturbances to the gyro-stabilized platform, ' 
including reaction tartjues due to a user's inteactiqns with 
the {device. The control system varies the speed the momety* 
turn wheels in order to maintain the gyro- stabilized platform 
in* a Axed position. In an alternative embodiment, a reaction 
sphere is used to pxodu.ee the requisite inertial stabilization. 
Since the sphere is capable of providing controlled toxgo.es 
about three arbitrary, linearly independent axes, it can be 
used in place of three reaction wheels to provide three-axis 
stabilization for a variety of space-based and terrestrial 
applications. 

DESCRIPTION OF THE DRAWINGS ; 

KEG, 1 is a. drawing of a one-dimensional space gyro- 
scopic model, as seen from an oblique perspective; 

FIG. 2 is a drawing of a three-axis stabilized system 
model, as seen from -an oblique perspective; . 

. KEG. 3 is a drawing Used to illustrate torque generation 
V/ith respect to a momentum sphere; 

FIG. 4 is a block diagram illustrating a closed-loop 
control system; 

FIG. 5 is a block diagram illustrating a closed-loop 
control system with disturbance; * ■ 

HCG. 6 is a block diagram depicting plant feedback with 
optimal feedback for linear regulations; 

FIG. 7 is a representation of a mathematical model of a 
1-X> model plant; _ 

FIG. S is a state diagram used to iliuBtrate position 
regulation of a 1-U satellite plant -using pole placement; 

BIG- 9 is a state diagram used to illustrate a final design, 
of -a 1-X> satellite model controller; 

FIG. 10 is a skeletal representation of momentum sphere 
housing; * . 

FIG, 11 is a simplified drawing of an aspect of a momen- 
tum sphere depicted hrhrared emitters and detectors; 

FIG. 12 is a simplified drawing showing a great circle 
band of reflective material around a momentum sphere; 

F3G. 13 is a drawing, seen from an oblique perspective^ 
illustrating a different aspect of a momentum sphere; 

FIG. 14 is a cross-sectional vie*w of a momentum sphere 
illustrating how a control subsystem may interact with 
optical emitters and a reflective band; 

FIG. 15 is a block diagram used to describe a momentum 
sphere control environment; 

FIG. 16 is a drawing; as seen from an oblique perspective, 
of a spacecraft including a pitch momentum wheel; 

FIG, 17 is a simplified drawing used to illustrate the 
stabilization of a gimbal sensor platform; ^ 

FIG. 18 is a block diagram of a single-axis momentum 
wheel for teaxestrial applications; -i 
FIG. 19 is a drawing of a momentum wheel viewed from 
a top-down perspective, before the application of motor 
current; 
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HEG, -30 is a drawing of a momentum wheel after the ' 
application of motor corrent; 
HO. 21 is a root4ocus plot; 

HIGL 32 is a time-response plot of a one-dimensional 
5 -motor' application according to the invention; 

' PXO. 23 is a graph used to ulustcatethc control effort of 
a 1~D motor;. 

KEG. 24 is a drawing, as seen from an oblique perspective, ■ 
10 'of a hand-held force-feedback controller utilizing three 
momentum wheels to provide inertia! stabilization in three 
spacer . 

■FTQ, 25 is a flawing of a block diagram of a spatially 
unrestricted force feedback controller utilizing three 
15 momentum wheels to provide inertial stabflizatian in three 
space. 

DKTAXLKD DBSGR3FIXOK OF THE ' 
PREFERRED HiMBODIMKJSrrS 

*2Q According to -fixe invention^ programmed amounts of 
rotary force are used fox motion, compensating and/or the 
stabilization of free-ftying platforms, or to provide force/ 
torque outputs from platforms to attached frames. Specific 
embodiments ' are disclosed with respect to spacecraft 
25 pftfrtmrafiftii, as well as to the application of forces and/or 
torques to band-held force generating devices, including 
joysticks, steering -wheels, , and implements of arbitrary 
shape for specific applications, such as sports simulations. 
By -way of introduction, reaction wheels use the inertia of 
30 one or more (typically xrp to three) rotating flywheels to 
generate torques- These wheels -are typically accelerated 
using electric motors -which can be controlled to increase or 
decrease rotary speed, mus -changing rotational momentum. 
*When me wheel on a particular axis is accelerated through 
E5 increased motor torque, .an equal and opposite reaction . 
torque is generated and applied to the base upon -which the 
wheel is mounted, 

' Reaction wheels axe the most precise type of attitude 
control mechanism. However* when called upon to provide 
40 non-cyclic torques, they must be periodically unloaded by 
other means (Le T when the motors have accelerated to 
maximum KPM in any direction, no additional acceleration 
can be realized in that direction unless the motors are 
slowed, generating torques in the opposite direction)* 
45 Moreover, to provide arbitrary torques, three wheel axes 
must be provided 

■This application describes how reaction whteels as cur- 
rently only applied only to spacecraft can be extended into 
several-other related terrestrial appEcationB, mcaiidiug gyro- 
stabilized bodies and tethered, force-generattng/reaective 
input devices- PrelimiBarBy, the following description will 
demonstrate and how three axes of reaction wheel can be 
-reduced into a single, reaction sphere, useful ^either in the 
~ apace-based or terrestrial applications. A description of 
' reaction •wheolsand&phereswia^rst be presented, followed 
by a discussion of the extensions to such technology made 
possible by the invention* 

Single Plane of Torque Action 
The single plane model for atorquer consists of a spinning 
wheel attached to a frame. There is a reference frame, B, 
embedded in the frame and a fe^ reference fmmc. A* in the 
world. Reference frame B is aligned with the axis of the 
spinning wheel. The system is shown ia FIG, X. 

The reference frame B has two degrees of freedom with 
respect to reference frame A* These degrees of freedom are 
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described' by generalized' coordinates g 4s where rep- 
resents the. angular decree of freedom about unit vector a x 
and represents the linear degree of freedom along unit 
vector a*. With, this model, the tnnt -vectors la frames A and 
B are related by 



The center of mass of the frame is located at the osigia of 
the B reference frame. The frame is assumed to be a. cube 
with a mass of M and height of 

The location of the center of mass of the -wheel, ti, is grveai 
by the -vector jp^j 

.■ . * (2) 

where 1 is the oiFsei from the center of the frame (la 
meters) and is a run-time parameter. The notation "V 6 ' 
denotes some vector v in reference frame B with respect to 
reference frame A. The mass, of the (assimaing without loss 
of generality a solid cylindrical disk) wheel is given by 



np*npj*h (3) 

where p is the density of the mat&xial of the wheel, r is the 
radius of the disk and h is the height of the wheel; and have 
the units of 'kg/xa 3 , meters and meters, respectively, 

The central inertia dyadic of the wheel is given by 

where 

The orientation -of the wheel with xespect to the feme is 
given by the generalized coordinates This generalized 
coordinate is about the h ± axis. 

The central inertia dyadic of the frame is given by 

where (assuming without loss of generality that the frame 
is cqbie) 

r - ***** 00 

Since there are two rigid bodies in this 'model (the frame 
and the wheel>* the angular velocities and accelerations for 
both must be developed. 

The reference frame £ is said to have a simple angular 
velocity in the reference frame A because there -exists for all • 
time a xmit vector whose orientation in both the reference { 
frame B^and reference frame A is independent of time. This s 
allows writing the angular velocity of reference frame B as 
die magnitude of its angular velocity times the toed unit 
vector- - 



To roake the equations of motion concise, a generalized 
velocity will be defined as „ 
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XJsvng the- definition xa Bqualira (&), ^tsf caa bs rewritten 

as . : 



' The vfh&el is said to have & siirrplB angular velocity i& the 
reference frame B because there exists for all tons & unit 
vector whose oxieatatioDL in both the wheel reference frame 
aad reference iraiue B is independent of* tLme. This allows 
•gflrifrfog the angular velocity of foe wheel as the magnitude 
of its angular velocity times the feed unit vector 



* ^ttf^jt- . - Cxi) , 

15 

. The angular velocity of the wheel in ref srence fcims A is 
given by 



20 *<^«C»r*tfj)&i- 

X>e&nng another generalized velocity, 

allows expressing Bquation (12) in terms of generalized 
velocities only as 

30 Av&stUi-btjfix. (14) 

The aaigular acceleration of refererice-feame B is found to 
be 

35 

and the angular acceleration of the wheel can. be wotcsn 

as 

40 

■V«(iJ 1 +ii 7 )6 s . (16) 

The location of reference frame B is given by 

45 

The velocity A y B and acceleration A sf of this £camc are 
- found to be 

so . . 

since the unit vectors a t are teed in reference £caxa£ A, 
Defining a generalized velocity 

»*=4* (19) 
allows rewriting Sanation (IS) as • - 

By d fffitwn jy the disturbance forces acting at the origin of 
reference frame B as 
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the disftarbkncei torque actios OJ1 frame- as 



Ifies^S/, and 



(22) 



■ and the motor torque, applied to the wheel, as " * 



(23) 



the equatkmg of motion arc found to "be: 




(24) 



To control Ms system, an expression for % d p&t allows the 
system to move from any value of {q. ls n 1 J to any other value? 
of in the presence of disturbance torques T^must b& 

developed (see Seciion below)* To- gain a' understanding of 
the system, first set %r=ti, liquation (25) can mm be written 
as 



-r^-h/^^a (26) 

From control theory* it is known tha$ this equation is not 
stable sine© the poles He on the imaginary axis. Thus, the 
form of ^required to satisfy stability cafiteiia must meet the f 
following; two criteria: 

1. !& -must move the poles of Equation (26) into the 
left-half plane. . _ 

2. It should utilize values of {q Xr q 7r u 7 } to control the 
system as these state variables can be measured. 

If the disturbance toxqno is not set oqnaL to 2exo > then 
Equation (26) is rewritten as 



and a third requirement for the control torque is added:- " 
3. It must be robust for a specified set of disturbances 
torque values and functional forms. 1 
- -Some simple relationships are also developed to suggest 
appropriate motor parameter values and sizes for the 
momentum wheels. For rsal world application,, it is impor- 
tant to be able to specify certain aspects of the problem, such 
as. force produced, the period of time for -which it is produced 
and the mass* of the device. Also, to stay firmly rooted inj 
xeality, it is iroportant to specify the power output of 'the. 
motor. 

• Hquatioxi (28) shows the basic aquations 

to==Ctri*=*U& • (28), 

where lis fh& moment of inertia of the momentum wheel 
(assuming that Stis a fhin hoop; for a. solid disk, J=w?f2 and, 
in reality, the actual value will fall some placs in betweea), 
mis the mass of the momentum wheel, x is the radius of the 
momentum wheel, t is me; torque applied to the operator 



(27) 
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(Which is the same as the tox-qae prodttce by; the motor); 
' is the angular acceleration of the momentum wheels m is the 
angular velocity of the moirien.tam-wb eel, t is the period of 
time fox which. the torque is felt and jP 3s. the power output 

5 of the motor. ' 

To feel a torque produced by. a motor that is not attached 
to some feed structure, the motor roror mast be accelerating. 
The rotor wall continue to accelerate unfit the? motor reaches 
its maxirmira angular velocity, a value that is dstenniiied by 

xo motor parameters (bat the calculation of which is not 
important for this analysis).. To increase the amount of time 
during which the torque can be fel^ it is necessary to slow 
down the angular acceleration of the motor by increasing; die 
moment of inertia of the rotor* 

is Equation (28) has fbdtr equations and sight parameters . Of 
these parameters, an equation is foxmed that relates m^t/t 
'and P because these are the parameters that can be controlled 
during the design of the device* One such form of this . 
equation is 
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Arbitrary Torajie Generation Fxom Wheels 

To generate arbitrary torques, a 3D platform consisting of 
iiiree spinning wheels attached to three non-coplanar •axes of 
a ixarae is required, (For edroplicity, and without loss of 
generality* this work assumes that the axes are mutually 
3Q perpendicular,) There is a reference frame, B, embedded hi 
- . the frame and a feed reference frame, A, in the world, 
Reference frame B is aligned with the axes of the three 
spinning wheels, thus defining a set of mutually perpendicu- 
lar unit vectors. The system is shown in BIG. 2. 
35 The reference frame B has six degrees of freedom with 
respect to reference frarne A. These degrees of feeedom are ■ 
described by generalized coordinates q lt • . . , where 
. * » , q 3 represent the angular degrees of freedom about unit 
vectors a^a^&s respectively and 'q^ . . * , q s represent the 
linear degrees of freedom along unit vectors a^a^a^ respec- 
tively. The orientation of reference frame B with respect to 
reference frame A -is described using a Body 3; 1-2-3 
representation. Table 1 shows the relationship between the 
unit vectors a ls a^ % and b xt b^ b 3 . 
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The terms c^s f are defined as cos (q£ and sin (c^) respec- 
tively. 

To simplify some expressions, the following terms are 
defined: 

2as--cj^ap3-hs3JFi . 2^e5c3fiii3+«^3*i Zb^eiQ2 

Since the equations of motion will be developed using the 
65 unit vectors in reference frame B, the unit vectors in 
reference frame A are explicitly presented using the terms Zj 
defined in Equation (30). 



For siiapHcifcy, and-without loss of generality, the center of 
rajas s of the frame is located at the origin of the B reference 
frame and the frams is assumed to be cubical with a mass of 
M and height' of &, 

The central inertia dyadics of the fearne is siven by 

whsm 

' -^JSL * . 03), 

The locations of the center of mass of the wheels* d^ arc 
given by the -vectors where 

V*«&z B p d( ^lb^ (54) 

where 1 is the -offset from th& canter of the frame (in 
anefcers), The mass of each wheel (assuming without loss of 
generality that each wired is a solid cylinder) is given by 

^^Tipy^h ' {35} 

•where p is the density of the material of the wheel* r is die 
radius of the flak and h is the height of the wheel and have ' 
the units of kg/m 3 t meters and meters respectively, 

Ths central inertia dyadics of the wheels are given by 

^^I^x+I^s^A^i {36) 
where/ * 

h ~ — - — 0 — *— 2* ■■ h~&~h- 

The orientation' of the wheels wth respect to the fcarne are 
given by the generalized coordinates e. 7!t . . - , These 
generalised- coordinates are about the b a » fc>2 T b 3 axes respec- 
tively. 

Since there are four rigid bodies in this model (the frame 
and the three wheels), the angular velocities and accelera- 
tions for all faux must be developed 

The angular velocity of the frame, is found to be 



To roake the equations of mod.au concise, thr&s general- 
ized velocities will be de&ried as 



■ Using the detention in Equation (3 9) ^af cm bo rewritten 
as 

A xts**=u i b 3 +U2b z +ii3k ? (40) | 

The wheels are said to have a simple angnlar velocity in; 
the reference frame B because there exists for all tune a unit! 
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. vector whose orientation in both, the wheel reference femes 
- and reference frame B is independent of time. This allows 
Wadtuig thp aagiiiiir vel oeities of the -wheels as the magnitude 
of their angular velocity times the fixed unit vector 

5 . . . 

'fflrtsgj&l *ffl^B&i *<tf*a*kl*. (41> 

The angular velocities of the wheels in reference frame A 
are given by 

15 ^CO'^^i^&a-K^+epX&a (42) 

Defining three; more generalised velocities, 

•20 . u-r=4 7 Beryls ( 43 ) 

allows expressing Hquafi.au (42) in terras of generalized 
velocities only as . 

25 , * - 

30 

Hie angular acceleration of reference frame B ia found to 

be 



35 



40 



45 



^^b^xh&^a^. - (45) 

The angular accelerations of the wheels can be mitten as 

A tr^=<il 1 "« 3 a ? )£ x ^^H^ t )i^^<t^-iT« 1 « 8 )& 3: 
The f ollomng terms are defeied to simplify the equations 



50 thus allowing Equation (46) to he rewritten as 
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There are four points of interest in this problem; the 
location of reference feme B and ths locations of the centers 
50 of mass, for each of the wheels. Hie location of reference 
frame B is given by 

65 and its velocity ' A y s and acceleration are found to be 

V^^i+^j*^ **^4*r*£^"*Wfe (50) 
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-since the mdt yeetoxs a* are &s;ed;ia xefere&ce frame A. 
defining generalized Velocities * 



U,M< Ks^ks V*r*to ' . <$ l ~> 

. allows xewri&ag Equation (50) as 

The velocities of the centers of masses of the wheels are. 
found to be 

i 

^V fe == J S^+ A CL^X2£> 3 -u^a^u^i^^tic a^rla^h-^—lujb^ (53) 

• and the accelerations of the centers of masses of the 
wheels are found to be 

There are three sets of forces acting on this system: the 
applied distarbance forces and torques .applied to reference 
fenieB that represent, the gca^itjr forces acting oil the wheel 
and fxam& masses and tb& motor torques applied to "the 
-Wheels. ■ 

Th e disturbance forces acting at the origin of reference 
frame B is defined as 

the gravity force on 'the frame is defined as 



or equlyalsntly as 



(56) 



and three gravity forces, which act at the center, of the 
wheels, are defined as 



Qjf°-*nsa* G<±~-mgA 2 G^^-ms^ ^ 

or cquivaleaily as 

The disturbance torque acting on the &am& is defined as 



and the three uaotor torques are defined as 



r^^i r^^&a zv**^ 
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With the jpodtLve sens© of the torque being applied to th& 
wheel. However^ Newton's second law demands that there 
be an equal and opposite torque applied to the frame* body 
B, Thiis, tftca resultant acting pa body B is given by 

The definitions of the generalized inertia forces was 
facilitated by defining; the; following terras; 

Zfo**Ktt&+uft Zbz~K#nt2+»$} 2ks**K»m~"#ti t 63 * 
The equations of* motion arc found to be: 

[(ii^^^-^^^^^^r^^o (64) 
Af^=0 - * 

35 ^-42^*0 

Since theare are nine generalized coordinates, there are 18 
equations of motion, nine Mneanatics and nine dynamic. To 
solve these equations numerically, they roust be written in 
4o the form 



. where flae state vector y has the form y={q 1> . , . * 4r»» 
45 , . . , vi n }„ This necessitates rewriting Equatioa (39) to solve 
for the q t in terms of the The EiB&kmematic equations of 
motion can now be written as 

5D ' . 

To mite tbc dynamical equations of motion in the same 
55 manner, Equation (64)- must he solved for the u*. Since 
• several of the Z s include u^ these tonus will need to be 
expanded. As a. first step, the foil owing terms are defined 



60 Zz-sr^i&x 2^-«i« 3 ^a««2«a (6f7) 

65 , " ^^(wi^^^)-^?^^)^^^-^ (63) 
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. X,**-^ X,?*-^ KgP-^ 

Hext, Equation (64) is rewritten in the forxciAti^E^, thus 
providiitg & means fox solving far the *a £ » is given in 
Equation (68) and A is defined as 
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where X^2Ii4-X 2 -h3^. 

A discussion of the control system is presented in below. 
To sixqpWty the equations of motion to -faciHtate control 
devclopinentj those tcmis and 'equations that deal with the 
linear positionTfoxce are eliminated "because a g~yro- 
sta^Mzed platform can only counteract torques ^ not forces. 
Rewriting Equation (69) as indicated yields 
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This equation can also be rewritten to explicitly express 
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where I 5 =<U^^ :i )-^- 

Arbitrary Torque Generation From a Sphere 

The equations of motion for the sphere, see KEG* 3, can be 
derived from those fox the three wheel device by noting 
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* these Wo salieat tKferencess between the systsms; the inertia 
of the sphere is equal in all directions mid is unchanged with 
oxienta&ons; and the center of xxuass of the sphere 5s located 
at the origin of reference frame B, The equations of motion 
5 for the sphere ara given h;y; 



IS 

%Z r 4%?&i&-i(r l ri£^Z l ii^I^ %-^«7)]=0 (72) 

Because the cxoss-eoapling through the linear "velocity 
terms does not exist for this device, controlling a. system that 
employs this device for stabilization is easier than control- 
ling a -system tot employs three reactions wheals for 
stabilisation. 

Control Issues 

Control theory is defined as a division of engineering 
mathematics thai attempts, through, modeling* to analyze and 
to command a system in a desired manner Of particular 
interest are closed-loop systems* In a closed-loop system, 
the; forcing signals of the system (calling inputs) are deter- 
mined (at least partially) by the responses (or outputs) of the 
system. In this maunsc, the inputs and outputs are interre- 
lated la K£Q. 4 r a generic closed-loop control system is 
shown. In order to explain me contents of this diagram, the 
fallowing example is used: 

The objective is to control the temperature of a room. Xu 
this case> the sensor is the thermostat The system input 
is set .by selecting a. temperature- Through either some 
mechanical or electrical means, the difference between 
the desired and actual temperature is calculated, result- 
ing in an error* If the actual temperature is below, the 
desired, the' compensator sends' out a control signal to 
the iurnace (or plant). If the control signal says'neat on 
* (actually, the eleclromechanical equivalent), the fur- 
nace outputs heat. This process continues until the 
compensator deteonines it is not necessary to heat the 
room, and tihe control signal is changed to a heat off: 
signal* 

Control theory can be classified in two categories: clas- * 
sical and modern. Classical control meory is generally a J 
tdal-and-erxor system, in which various type of analyses are* 
used iteratively to force a electromechanical system to- 
behave in an acceptable manner. In classical control design, j 
the pedcoimance of a system is measured' by such element^ 
as settling time, overshoot and bandwidth* However, fori 
highly - complex, mtdnVinput/multi-output (MIMO) systems) 
entirely different methods of control system design shooldj 
- be implemented to meet the demands of modem technology, ' 
Modem control has seen wide-spread usage within the lastj 
fifteen years or so. Advancements in technology^ such as J 
faster computers, cheaper and more reliable* sensors and the j 
integration of control considerations in product design, have 
made it possible to extend the practical applications of 
automatic control to systems that were impossible to deal 
with in the past using classical approaches- Modern control 
•theories axe "capable of dealing with issues such as perfor- 
mance and robustness/ The spatiaUy-unrestdcted force- 
feedback system makes use of two modern control design 
methods: disturbance rejection and optimal control. 
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■ In the design of electromechanical systems, one can 
consider that the system will bo exposed, to dismrbaucss. A 
disturbance may be defined as any unwanted hxput- 3a FIG- 
5, Hie distabance, v?(t) f is shown, as a second input to the 
5 plant Thi effect of the disturbance is added to the output of 
the plant. 

Distnrfiancs rejection design can. be used to create a 
compensator wMch is able to ignore; the disturbance and 
.cause the desired plant output. In this section, the basic 
io method of disturbance rejection, design is presented using a 
MMO model, For this model, notation must be established 
to designate the various dements of the contra! design; let; 

l&t B> C, I>] be'ia stats-space representation of tbe plant 
(with state xj, assuming (A3-) completely contolLable, 
is - 

X(t)e "bo the plsut state, 

n(t)e 3^ be the plant Input (wbcro n ; aa tho mtmber of inputs 
.and Ho is lhe number of outputs), 

. 20 w(t)e be -die disturbance; input 

x(t)e 3$**° bo the desired or xe&ocerca injrai 

y(t)s 9& n * hs the ssnsor oiitpat 

c(t)s fit"* be £hs traoHng sctcar 



25. 



The lumped MEMO linear, tims-invariant (LXI) system^ 
may be expressed as: 
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? 5 The model for the input CEqnatkms (76X77)) and tte 
noise <Hq«ations (7S)-<79)) fire: 



AO 
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The objectives in the design of the feedback system in 
BEG.. 5 are as follows: 

Closed-loop system must be escponentially stable, 
Achieve asymptotic tracking and disturbance: rejection for 

all inirlai'states 
Robustness 

If this is true, then for all initial states of the system* 

55 e(t)->0e as t-^. 

Giveii the systern fA^,C T Dl, suppose it is minim al.. Let 
• th& coiBpensatar be given by 

where 

65 . A^gcr^.-^rjsSt^ (fit) 
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with 

* o i : n ■ < fi s> 

■ D ... 1 

1 



(84} 



Since and A r are known, [83] can be derived j&rom the . 
equation 

•which is the least-coramon multiple of the characteristic 
equations of A^ and A r . 
Under these conditions, if 

1 c A ^]-"^ v ^°C^>^A r )3 1 

(which guarantees that the system is still completely 
controllable vrfth the addition of the compensator) then 
The composite system is completely controllable 
Asyroptotie tracking and disturbance rejection holds 
Asymptotic tracMag and disturbance rejection are robust 
The discussion .contained her© is establishes a xnamemati-- 
cal basis for the invention. Control of a gyre-stabilised force 
feedback device is based on its ability to respond robustly tc 
a control signal and to respond correctly despite system 
■ noise. For €he sii^e-inpiitMngle^utput (SISO) case Y this 
theorem reduces* to fee classical control case where an 
integrator is required fox robust performance. ■ This result is 
used in -the design of the ID experiment which is similar to 
the classical satellite control problem. 

Optimal control theory can be used to design compensa- 
tors which are able -to takes into account the cost of perform- ( 
ing a- particular action. A classical example of optimal 
control i& the use of fuel to maneuver a satellite in orbit 
above the earth- Two extreme scenarios are possible; move- 
ment taldng ' minirnum time or movement taking mtn ir mrm 
faeL In the following section,, discussion will focus on the 
fundamental principles of optimal-control design, 
* The optimal control problem is to find a control n*(t) 
•which causes the system s(t>alx(t), u(t), t] to follow a 
desired trajectory that nntrirmftss the performance mea- 
sure 

(87)1 

C $* 

• X&)~W*C0> 1 ^ 
-> Jo 

i 

Other xiam&s fear J include: cost rhnettoa, penalty mnctxon* 
and performance index. Assume that the admissible statsl 
and control regions are not bonndedT (This removes allj 
mechanical constraints; these can be included in later 
development) "Let the initial states, x<taHKo, of the system; 
and initial time, to* be Icnown. Also., let 5lg= and ue Bl m - 
The goal now is to establish tote necessary conditions fori 
optuxiaHry: ' . 

Assuming that h is diSerentiable and that initial condi~j 
tious are toed and do not afeet mirdmization^ [b 87] can bej 
expressed as 
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(88) 



5 *' Far generality, apply the chain rule and include differen- 
tial eqaa&on constraints to form an augmented cost function: 



r • (89) 



"dT 



i5 using Lagrange multipliers p t <t) t , . . t ftjCt). To ^ixnpllfy 
the notation, rewrite 0 as follow: 



««) «f * toG*(0. *C3. K*)> 0}^ 



(90) 
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The necessary conditions for optimal control can be 
derived using calculus of variations. Specifically; -talcs fee 
variations of the functional JJu) by 5x, ox, 5u t 5p and ot^. 
(SQcarcnient of the f unctional J is defined as: AJ(3C,. &)=5J(:x» 
25 5xHeCk>~ Sx)-Ps:11; SJ is linear withxespect to 6x; Sx is called 
the -variation of the function x.) From lids, the necessary 
conditions may be derived: 

a • (91) 



30 



35 



40 



for all te-fe, T^L and 
where 

45 . *^>^).PC^ CPS) 
The principles of calculus of variations are applied to the 
• - design of a linear regulator. The linear regulator 'is used in 
the control of the motors used to spin the hiertial masses to 
$0 change the attitude of the satellite system. The regulator 
design is particularly useful in controlling unstable systems 
through "optimal pole placement* First, recall the state eoua- 
. txon of a linear, tirae-varyiag plant: 

The- cost function to be used is 

so + ir J i^mcm^ + * r cw*M$]* 

sphere t/s fixed, H and Q are xeal, positive-serni-defixdte 
matrices, and R is a real* positive-definite matrix. Th& 
purpose of the regulator is to maintain the state of the system 
65 as close to a desired set of parameters as possible without 
excessive -control effort The necessary conditions for opti- 
malifcy to be used are; 



■**(f}^&x*{fyrBi?)u *0) (98) 

"where the Harmltonian is defined as 

Bquation, (100) is easily salved for the optimal input for 

the regulator, yielding 

i si ' * 

t 

It is now possible to form an augmented, cLos&d-loop 
state-space equation of the regulated system: 

r **c# 1 - f ^ ~ m 53,(19 1 r 1 cw l 

These 2n differential equations have a solution of lite 
foam 

Note: <j>(t^t) is called the transition matrix, defines by 
d/dt4<t J ^t>=^A.(t)^>(t f? t) with the initial condition of §{ta>i^=*l 
and is salved through numerical integration. By partitioning 
tiie state traasMpn ibaxxbc, 4^ 4 ^ xe following solution for 
p*(t) can be reached: 



p*(^^^). (105) 

Therefore, the optional control law is 

the next step is to define a method of solving for K* This 
is adxieved using a Kiccatt-type differential equation: 

Which involves solving n(n+l)/2 first-ordsr • differential 
equations. Fortunately, the; motor system involved in the 
hand controller control system can he considered, time 
invariant. This snaplifbs His previous equations, which can 
be stimroariaed as: 

and the optimal control law is 

^t^~fr~ x & r J^(ry^Vj^x?j , (ill) 

As long as Q is positive definite Hie closed-loop system 
is guaranteed to be stable and the controller may be used for 
pole placement design of the system, as shown in KG. 6. 
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. The design of the controller system for the ID model is 
sow presented The :61st segment of the; design is a optimal . 
pole-placement This is needed because a the ID model of 
' the spatially Uiorestricted farce feedback device (which is a 
5 srmplffieci version of the actual 3X> version), which, can bo 
considered' a secoad-ordar system,, is inherently unstable 
Petitions of "stable" vary; hcsics, "stable is considered any 
plant which has only poles and zeros to the left of the 
1Q imagery axis in the complex plane (i.e. f left-hand poles and 
zeros), Using previously established results, the poles of the , 
system, arc placed optimally based on the inertia of a 
second-order linear -modcL Lastly, disturbance rejection is 
augmented to thg -control system for robustness, 

1S The plant far a single E>GF hand controller, BIG. 7, has the 
form 
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where a(t) is the angular acceleration, I^is the ineriial 
mass, and it(t) is the torque. 

Since the -stability of this system is (at best) -marginal, a 
pole placement is p&riE armed. Farther, optimal methods are 
employe^.- for placing -these poles at the best locations.. The 
new plant vaE follow the model in HG. 8. The optimal 
design wi31 give the "best" values to use for K x and K 2 . 

The first step is to choose 1he cost function to mmimizo, 
30 set initial conditions, and select the necessary conditions and 
boundary conditions wliich apply to this problem. X*et the 
irdtlal states of the satellite be zero: x<0>M); x(0)=Q. The cost 
fimctiqn for minima} control effort is 
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(113) 



such that the? amount of acceleration of the system* 
4° whether it is positive or negative,- for .all time is mirdmal 
This is frequently ttsed for satellites because the amonnt of 
acceier-atiGn is lie raagBitude of the control input, or for 
satellite, the jrmbunt of fuel, which is & limited resource. For 
this system, the f oHpwing parameters are haowfi: 
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(115) 



with a. state defined by . 



ra-[:] 

OOSi 

[r 



and choose 



and X— 1» 

For the I3TRicatti eqoafckm, [110], K has four solutions^ 
but the only positive-deferlte solution is 
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which results in a regulate, F, of "She following form: 



and -velocity feedback required for optimal tracking, as in 



The final step is to include an integrator which provides 
the SISO case with robustness. The iinal controller design is 
shown in KEG. 9. 

There are some control issaes that are specific to the 
momentum, wheel concept. These issues are those feat deal 
with determining &ie state of the sphere, which xsmst be 
3oaown to calculate the sphered angular momentum vector. 
Since the natnre of a spherical object allows it to be at any 
orientation relative to it' s cavity, a method that can detect the 
sphere* s exact orientation relative to the three tbcad crfhogo- 
nal axis of -the sphere housing is used. This is Illustrated in 

keg. 10. 

Bach of the three; sphere housing axis is outfitted with a 
band of optical infra-red emitters to detect -the relative 
position of the sphere. Each emitter wfli be placed between 
two (or more) infra-red detectors as shown in KEG. IX. This 
technique wSI enable fine position sensing and s;hTanlta« 
ncously rairdroibe power regnirements since; a single emitter 
will servicer two (or more) detectors. 

. The sphere is equipped with, a single great circle hand of 
reflective material as illustrated in HT<3.' 12. As shown in 
HEG. 13, ftach sensor band on the sphere fioti|dhg covers one 
half of the great circle bund on each sphere housing axis. 
Consequently the refteerive band is always within range of 
at least three optical emfctei/detectar pairs regardless of 
sphere orientation. t 

The IR cmittcr/dete ctor sensors are located directly on the 
cavity face to simplify con&lxtxoiion of the sphere housing. 
Bach emter and detector is directly interfaced to the hous- 
ing cavity by a fiber optic cable that ends at a lens mounted 
on the cavity face as shown in BIG- 14. Using a leas permits 
tile use of lower power infra-red emitters. 

As shown in FIG. 15, the infra-red emitters are driven by 
an output bit from the Sphere? Control Computer. Address 
decode logic and latch bits contained in the Sphere Control 
Subsystem decode ejpitter data from the control computer 
and tarn the appropriate IR emitter on. The control computer 
reads the associated IR receiver, via the same decode mul- 
tiplexor logic in the Sphere Control Subsystem. 



There aretwo itxtcr-related "branches of mechanics that axe 
nsed to spacecraft control: celestial mechanics and attitude 
mechanics. The former deals with the position and velocity 
of the center of mass of the spacecraft as it, travels through 
•space j whereas the latter deals with the amotion of the 
spacecraft aboatits center of mass, sse'HCG- 16. 

Attitude mechanics is divided into three components: 
dsterxoittatkm. prediction and control. Attitude deterxedna- 
tton is the process of completing the consent orientation of fee 
.spacecraft with respect to some specified ineriial frame. 




Conventional Applications to Spacecraft 
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Attitude prediction is the process of compiiting the future 
attitude of the spacecraft based on its current state and 
* motion* Attitude controlis the process of applying torques to 
.the spacecraft to reorient it into some desnred fates state. 
5 The devices mentioned in this patent deal primarily -with the 
control aspect of attitude mechanics. 

For most modem spacecraft applications, thre e~ axis . c on- 
trol is required* This method of control allows' mission 
planners to specify the orientation of -the spacecraft at all 
10 times during the course of a mission. Missions that employ 
this- type of control include aE communications satellites ? the 
space 'shuttle and earth-orbiting scientific satellites. 

To functidh 'properly, three axis stabilized spacecraft 
employ sensing devices that identify the spacecraft's sititn&& 
_ by determining two mutually peapendicular orientation vec- 
° tors. Some typical- examples include two-axis sun sensors 
and magnetic field sensors. Once- the spacecrafts attitude is 
determined, the mission profile determines the control 
requirements. Certain scientific satellites require • extremely 
precise attitude control (arc-seconds) for the purpose of daxa 
20 collection. Others,, such as C-band television satellite^ 
•require less precise control (arc-mimites). Since all satellites 
• 1 are subject to disturbances, some method of maintaining 
proper orientation is required. 

There are three primary means for controlling a satellites 
attitude: gas jets t electromagnets and reaction wheels. Reac- 
tion jets operate by expelling gas through an orifice to impart 
a moment on the spacecraft. These devices can produce large 

- (but imprecise) torques, but since they expend fuel, there 
on- station operating time is limited. Electromagnets operate 

30 by creating magnet fields -that interact wifii the magnetic 
field of a nearby body to produce & torque on the satellite. 
Although these systems do not expend fad., they only 
function near bodies with large magnetic fields, Reaction 
wheels operate by way of Newton's third law by accelcrat- 

35 ing a "wheel to absorb torque that is applied to the satellite. 
If the applied <Hsturbances are- cyclic, these systems can 
operate ^definitely since there is hot net gain/loss of energy. 
For real-world systems, reaction wheels typically operate in 
conjunction with gas jets* which are rtsed to bleed off excess 

40 momentum as the wheels approach their operating condition, 
boundaries. Reaction wheels provide a very fine degree of 
attitude control. 

Applications for Platform Stabilization. 
45 "What differentiates space-based applications from other 
applications is not the lack: of gravity but rather the fact that 
gravity is the same in all directions. Similar situations can 
occur on the Barm: system with neutral buoyancy in a liquid 
" and systems that are fixed 3b the direction of gravity operate 
50 under similar principals as space-based systems, see FIG. 

For example, consider the case where a sensor platform is 
to collect data from a lake over a period of time. If this 
platform it required to maintain a particular attitude, a 

55 gyroscopic system can be used for stabilization. Sirnilarly, & 
sensor platf<aia mounted on a research balloon may be 
required to Tnafrrfoire two-axis attitude control fox the dura- 
tion of the mission. Again* a gyroscopic system can be used 
to stabilize the two rotational degrees of freedom of this 

60 system. 

EKAMPL33S 

Two sets of espenments were carried out with the single 
degree of freedom device. The first experiraent was intended 
6S to, validate Equation (119), A second experiment was 

- intended to demonstrate a control system for a three DGF 
system. r 
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To carry out these tests, a test stand was developed, as 
fihowa in KEG. 16. 
This test setup consists -of the foHowing components: 1 
A turntable "With an attached motor.- The position of the* 
turntable is instrumented with an incremental encoder 
attacked direc&y to the turntable (not used in this, 
expeerimexit). The position of the motor shaft was not 
instrumented* however, its angular velocity is instru- 
mented. Tha motor employed is a Hathaway modal 
1500, attached to the turntable by means of an adapter 
block. 

A momentum wheel attached to the motor shaft. This 
momenton wheel is maniifactured ixom a piece oi 
stock, 2 inch diameter, cast iron shaft-. 

The motor is attached to a C^berlmpaat® Intelligent, 
Motor Controller (I&fC) system, a standard Cybernet 
product and is used' with all of our force feedback 
devices, which provides an interface to a PC based 
controller that allows for , a wide range of motion 
commands to fee programmed. 

The IMC is attached to a PC In this example, a simple, 
previon&Ly developed interface to start and stop the 
motor "was employed* This interf ace presents the user 
with an input screen for directly controlling the alitor 
current. By setting, the current to its :maxLmuxa allow- 
able value, the maximum obtainable torque is observed. 
By setting the current to zero, the mote oom.es to a 
stop. 

A torque measuring system consisting of a spring and a 
camera. Applied torque was measured by the displace- 
ment of a known spring and the time for this to happen 
by counting video frames- 
The position, velocity, and/or accelexation provided on a 
user-hateractahle member is sensed and transmitted as a 
command -to a computer model or simulation which imple- 
ments a virtu a^reality force field. In turn, the force field 
.value for the given position, velocity, and/or acceleration is 
sent back to the member, which generates a force command, 
thereby providing the user "with direct kinesthetic- feedback 
from the virtual environment traversed. Although applicable 
to controlling a virtual or simulated environment, the tech- 
nology' is also well suited to the control of a remote, or 
physical device. Further, the present invention is suited for 
application to any number of axes* 

The operation of the 2MC system and PC interface will be ' 
best understood by referring to commonly assigned U.S. Bat 
Kos. 5389*865 and 5*459,382, andpending applicalionfiSer. 
Hos* 08/513,488 and OS/543,606, the contents of each of 
which are incorporated herein in their entirety by reference. 
These patents and co-pending applications describe systems 
and methods for presenting forces to an operator of a remote » 
device or to a user interacting with a virtual environment in ( 
multiple axes sirnultaneonsly'mealated through a computer j 
controlled interface system which provides a position, 
velocity, and/or acceleration (to be referred to generally as t 
* force.**) to a user interface which, in tarn, generates an 
electrical signal 'for each of a plni-aliiy of degrees of free- 
dom. Thcs e electrical signals' are fed to a virtual reality force 
field generator .-which calculates ' force field values for. a 
selected force field These force field values are fed to the 
force signal generator which generates a force signal for 
each of the plurality of degrees of fireedoxn of the ns ear as a , 
function of the generated force field. These mohW com- 
mands are fed back to actuators of the user interface which 
. provide force to thfc user interface and, thus, to the user in 
contact with the interface device. 
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Before discussing these applications in farther detail* a 
background will be provided With, respect to inertial stabi- 
lization as its relates to reaction wheels zmd space-based 
applications, as certain principles of spacecraft platform 
stabilization have, for the fest time ■ according to .this 
invention, been -applied to spatially unrestricted taxcstrM 
control- 

Experimental Data for ID Device Implementation 

Since a known xnoiaeatam wheel was used, the form of 
Equation (29) is not quite right for mis experiment. Instead, 
this equation is rewritten as 

* t 

where the factor- of two is used because a solid disk, not 
& thin, hoop, was used. The muss of the momentum, wheel is 
0,277 ifg (measured) and the inertia of the motor rotor is 
20 ignored.' 

Using the motor electrical parameters and the electrical 
characteristics of theXMC chassis, the rn a xiimrrri torque that 
can be applied by the motor is Mown to be 0.18 Nia 
Insertiiig these values into Equation (119) yields a time of 
25 0.09 seconds. 

To measure the torque, a spring with a spring constant II 0 
K/m was attached to the adaptor block; by -way of a bolt, at 
a. distance of 0.050 ra from the center of rotation. Since TMa: 
and -r=Fd, these terms can be related in the following manner 
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Of course^ the equations used are very primitive and dp 
not account for many of the real-world affects. The afreets. 
35 which are primarily fdctlve in nature, should tend to make 
the displacement less than predicted and the time -greater 
than predicted. The results of these experiments are shown 
in BIG." 19 and KEG 20. The picture on the left shows the 
' system just before current is applied to the? motor. The 
picture on the right shows the system at maximum spring 
extension, which occurred five video frames, .at. 30 frames 
per second, later. The results show a displacement of 1.2 
inches (0-030 m) and a time of 0.16 seconds. Given the 
experimental setup, mese xesults.'are well within the range of 
experimental error, thus giving credence to the modeL 

Experiments were also performed to control the' position 
of the turntable, in the face of disturbances r by controlling 
the speed of the momentum wheeh .The equations and 
methods used to develop this control scheme were discussed 
previously. For this e:K$edincnt > the same setup was used as 
for the previous experiment with .several small modifica- 
tions: ■ . * 
'The mstrumentad readings from the turntable and the 
55 . motor shaft were used by the controller. 

The spring was removed from the experimental setup. 
A control program was written that interfaces directly' 

With the 2MC system. 
Using MATLAB, which is a PC based mathematical tool 
so designed to aid, engineers in the development of complex 
mathematical .systems, the .controller and plant were simu- 
lated. Since the amount of control input is not a particular 
concexn, optimal control parameters were selected to pro- 
duce a system that responds quickly. Xa the following 
65 experiments, the values ^i=4^~ 1 0 and 3R==d were selected. To 
select an appropriate value for the disturbance rejection gain, 
a root locus plot of the system, FEG- 2.1, was developed. 
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rramtbis diagram, the gain of the system, which, is selected 
to produce fast response Urns, has value of approximately 
3L33xl(r s . The response of the system. • of a unit step 
disturbance is shown in KEG. 22 (plot • generated from 
MatlJab). These parameters "were then used in testing* a real 
model of the system. 

The control parameters deterrrrmcd using the ■ optimal I 
control teclimques and the root-locus method were applied 
to the system, shown in FIG. IS (without the spring). Sines 
the. control equations require the moment of inertia of the 
platform, "CAP tools were used to calculate the moment of 
i iacrtxa of the motor, the adapter plate and the bolt One item 
' that was not modeled in the simulation, or the calculations 
for determining control parameters, was the faction in tht 
system. ' . 

3k tiiis particular device, there was a great deal of Cau- . 
lomb friction in the base beariug. The camponeatsmonaied" 
to the base would not complete a single rotation before 
coming to a halt after an initial spin. This has the effect of 
adding instability to the system. Ia particular, what tends to 
happen is that the system will stay at some point for some 
period of time while the integrator error (the disturbance 
rejection) adds -up. At some point, there is sufficient energy 
to overcome the static friction, • which is less than the 
dynamic friction. Once moving^ the system will tend to 
overshoot the desired point and try to compensate., bat the 
same sequence of events occurs, 

KEG. 23 shows actual data from an e^eomeat to control 
the physical device. Despite 'the ftdcHon problem, the results 
from Ibis test are as expected. The system does oscillate 
about 1be control point, though it is quite noisy. 

An experiment was also performed to determine if -the 
forces generated were noticeable by a human. To perform 
this experiment, three motors with- momentum wheels were 
mounted onto the adapter block used, in fire previous experi- 
ments. 

The motors were spun up to a speed of 5000 RP3yL 
mdividnals were 'asked to handle the device and to make 
subjective evaluations of the torques felt as the device was 
moved about; In all cases, the subjects reported feeling 
appreciable: forces that were deemed to be sirf&cient for 
carrying out meaningful tasks. A. picture of the device is 
shown in PIG- 24. 

The torques felt were generated because the control ( 
system had been commanded to maintain the iaomcntum 
wheels at a constant angular velocity. By moving the device 
about, the angular momentum vectors were changed,, thus , 
causing a torque* The control system compensated for; these 
motions by adjusting the output to the motors. Since the 
motors were already spinning at high speed, the period of 
time for which a torgue could be applied was far more 
limited than for the case where the motor ia initially at rest. 

Having demonstrated that f areas can be generated in any 
direction, the final taak is to control the motors in an 
appropriate manner so as to provide hap tic feedback to the 
taser. This ta sir requires a sophisticated control algorithm for 
two reasons: first, the platform, win be grossly displaced 
froin its aoiuinal" operating orientation, and second, for any 
motion of the platform (for simplicity consider just rotations 
about the world coordinate axes with which the device is 
imtially crfehtedX some subset of the motors will produce- 
torques (due to changes in the orientation of the- angular 
momentum vectors) that are undesired To counteract these 
undesired torques, some subset of the motors will need to be 
accelerated to produce counter torques. The control system 
must model the full, non-linear dynamics of the system, 
have a high speed attitude sensor and possibly a control to 
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smoothly generate fee prescribed farces. A bloci: diagram of 
■ the system is shown in jHGGL- 25. . 

Applications 

5 As discussed above, one fwxaLy of applications for the 
devices described above utilizes inputs received from a 
virtual enidronment.' Far this type of application, the virtual 
environment models same set of obj ects, and hand controller 
or other forc^-xefteclkm device produces farces that are 

10 representative of some acavity within the virtual environ- 
ment Since it is not required that the forces produced 
correlate to any specific activity, the only restriction placed 

• on the corerparids sent to' the gyro-stabOized device is that 
the output forces be within the range offerees ttiat the device 

15 can produce. An alternative family of applications for these 

• devices produces forces in accordance with inputs received 
from' a (possibly remote) .'physical device* For this type of 
application > the forces produced are typically a scaled rep- 
resentation of the actual forces produced at some point on 

2Q - the actual physical device. To provide the -widest range of 
haptic input; the scaling U typically designed such that the 
maximum force that can be applied to tli& physical device: is . 

• mapped into the maximum force that the haptic device can 
produce. _ " 

To the first order,' the devices described are marginally 
stable at best. To control these devices to produce desired 
torque outputs in the face of input disturbances, a two step 
controller i& preferably utilized. The irrst step stabilizes the 

30 controller by doing a pole placement, The location of the 
poles can be determined using* any applicable method 
although optimal control is preferred. The second step 
creates a robust controller by canceling- out disturbance 
inputs. Robust control theory is applied for this task, 

35 With specific regard to platform stabfi.ir,ation > the desired 
input is typically a. zero input, Le, y that the system should not 
change state. Bar these applicatiansv sensor are employed to 
determine when the system, changes state due to distor- 
; bances and thecontroEer acts to return the system to the zero 

40 state, 

Unloadhag 

The human operator who controls the haptic device is* ' 
from the perspective of the momentum device, equivalent to 

45 group. Although any amount of angular momentum can- be 
xeinoved from the device when it is coupled to ground, since 
this is a haptic device/ the strategy is to slowly and con- 
tinually remove angular momentum so as to have as minimal 
affect on the user as possible. 3h particular, the momentum 

50 sphere has a maxirnum speed at which at can operate due to * 
the materials and .construqtion techniques employed. When 
the sphere approaches this Tna^im^Tn. velocity, momentum 
must be unloaded from the sphere for it to continue to 
function. To do this requires the application of an external 

55 torque that will cause -the angular momentum vector to be 
diminished. This can be accomplished in three ways: reac- 
tion jets, magnetic field torquers and/or spacecraft reodeii- 
tatipn* The first two methods work: by applying a torque to 
the spacecraft that diminished the angular momentum of the 

So sphere. The third method works if the following two con- 
ditions are met: the disturbances to the spacecraft are 
primarily apphed in the same direction and the spacecraft 
can continue to operate at different attitudes. 3f7 "these con- 
ditions are met, the spacecraft can be reoriented such that the 

65 disturbance torque act to cancel the sphere* & angular 
momentum. It may also be feasible to rigidly conple the 
platform to ground for a brief period of ticae. While coupled 



